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Abstract 

A  direct-drive  arm  is  a  new  mechanical  arm  in  which  the  shafts  of  articulated  joints  arc  directly  coupled 
to  the  rotors  of  high  performance  torque  motors.  Since  the  arm  does  not  contain  any  gears  or  transmission 
mechanisms  between  the  motors  and  their  loads,  the  drive  systems  have  no  backlash,  small  friction  and  high 
mechanical  stiffness,  all  of  which  arc  desirable  for  fast,  accurate  and  versatile  robots,  At  the  Robotics  Institute 
of  Camcgic-Mellon  University, we  have  built  a  first  prototype  direct-drive  arm  (referred  to  as  CMU  DDArm 
hereafter).  ,This  paper  presents  the  characteristic  analysis  and  the  design  of  tlic  control  system.  First,  we 
describe  an  outline  of  the  developed  CMU  DDArm  and  compare  its  characteristics  with  conventional 
indirect-drive  arms.  Second,  we  discuss  basic  feedback  control  for  single-link  drive  systems  in  the  frequency 
domain.  Third,  we  apply  a  feedforward  compensation  to  the  control  of  multi-dcgree-of- freedom  motion  in 
order  to  compensate  for  interactions  among  multiple  links,  and  Coriolis,  centrifugal  and  gravitational  forces. 
Finally,  the  steady-state  characteristics  are  discussed  with  respect  to  servo  stiffness  and  positioning  accuracy. 
The  experiments  show  the  excellent  performance  of  the  direct-drive  arm  in  terms  of  speed  and  accuracy. 
Throughout  the  paper  comparison  with  indirect-drive  methods  is  made  to  contrast  the  advantage  of  the 
direct-drive  method. 
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1.  Introduction 

As  robots  find  more  and  more  advanced  application,  such  as  assembly  in  manufacturing,  accurate,  fast 
and  versatile  manipulation  becomes  necessary.  One  of  the  difficulties  in  controlling  mechanical  arms  is  that 
^ey  are  highly  nonlinear  and  involve  coupling  among  the  multiple  links.  Recent  progress  in  tlic  analysis  of 
arm  dynamics  allows  the  real-time  computation  of  full  dynamics  using  efficient  algorithms  in  a  recursive 
Lagiangian  formulation  [6],  a  Newton-Euler  formulation  [10]  [13],  or  a  table  look-up  technique  [12].  When  an 
arm  is  severely  loaded  or  high  precision  is  required ,  deflections  in  mechanical  components  are  a  significant 
part  of  arm  dynamics  [3].  When  arm  dynamics  arc  identified  accurately,  feedforward  compensation  of 
nonlinear  and  interactive  torques  combined  with  optimal  regulators  for  the  linearized  system  improves 
control  performance  greatly  [15],  and  guarantees  a  global  stability  over  a  wide  range  of  arm  configurations. 

Critical  obstacles  to  the  use  of  dynamics  models  lie  in  the  uncertainty  of  arm  dynamics  and  the  difficulty 
of  identification.  Even  a  single  component  in  a  drive  system,  such  as  a  gear,  a  lead  screw,  a  steel  belt,  a 
servovalve  or  a  pipe,  has  complex  and  changeable  characteristics  in  terms  of  friction,  deflection,  backlash, 
compressibility  and  wear.  One  way  to  proceed,  when  arm  dynamics  arc  not  well  identified,  is  to  use  model- 
referenced  adaptive  control  to  maintain  a  uniform  performance  [5].  Its  extensive  application  has  shown  to 
allow  decoupling  of  the  arm  dynamics  in  a  Cartesian  coordinate  system  [14],  the  reduction  on  computational 
burdens  [7],  and  high  speed  control  [9]. 

Alternatively,  a  rather  straightforward  way  to  achieve  high-quality  dynamic  performance  is  to  pursue  a 
new  mechanism  which  contains  very  few  uncertain  factors.  The  obedient  characteristics  of  the  simplified  arm 
dynamics  will  make  it  easy  and  effective  to  apply  sophisticated  control.  A  direct-drive  arm  is  a  new 
mechanical  arm  which  meets  these  criteria  by  radically  departing  fiom  conventional  arm  mechanisms.  In  a 
direct-drive  arm,  unlike  a  conventional  mechanical  arm  that  is  driven  through  gears,  chains,  on  lead  screws, 
the  joint  axes  arc  directly  coupled  to  rotors  of  high-torque  electric  motors,  and  therefore  no  transmission 
mechanism  is  included  between  the  motors  and  their  loads.  Because  of  this,  the  drive  system  has  excellent 
features:  no  backlash,  small  friction  and  high  stiffness,  llie  authors  have  developed  the  first  prototype  of  the 
direct-drive  arm  with  six  degrees  of  freedom  [1]  [2].  This  simple  mechanism  allows  a  clear  and  precise  model 
of  the  DDArm  dynamics,  which  is  of  special  importance  not  only  for  accurate  positioning  control  but  also  for 
compensating  interactive  and  coupling  torques  in  high  speed  manipulation.  This  paper  describes  a 
characteristics  analysis  of  the  direct-drive  arm  and  the  design  of  a  control  system  to  achieve  the  ;  nential  for 


2.  Outline  of  the  Direct-Drive  Arm 

llic  overall  view  of  the  developed  DDArm  is  shown  in  Photo  1  and  its  assembly  draw  ing  in  Figure  1. 
(Tlie  detailed  description  and  data  about  the  CMU  DDArm  arc  found  in  [2],  The  arm  has  6  degrees  of 
freedom,  all  of  which  arc  aruculatcd  direct-drive  joints.  From  the  upper  base  frame,  the  first  joint  is  a 
rotational  joint  about  a  vertical  axis,  and  the  second  is  a  rotational  joint  about  a  horizontal  axis.  'Fhe  tliird  and 
fourth  joints  rotate  the  forearm  about  the  center  axis  of  the  upper  arm  and  about  its  perpendicular  axis, 
respectively.  The  fifllt  and  sixth  joints  perform  a  rotational  and  a  bending  motion  of  the  wrist  part.  The  total 
length  of  the  arm  is  1.7  m,  and  the  movable  part  from  joint  2  to  tltc  tip  is  1  m.  The  movable  range  of  joints  1 
and  5  is  330  degrees,  and  the  remaining  joints  can  move  180  degrees.  The  maximum  payload  is  6kg  including 
a  gripper  attached  at  the  tip  of  the  arm. 

High  performance  DC  torque  motors  were  used  for  the  direct-drive  arm.  The  motor  consists  of  a  rotor, 
a  stator  and  a  brush  ring.  As  shown  in  Figure  1,  each  component  of  the  motor  is  installed  directly  at  the  joint 
housing:  the  rotor  on  a  hollow  shaft,  and  the  stator  and  tlic  brush  ring  at  the  case.  To  develop  a  torque  large 
enough  to  rotate  the  joint  shaft  directly,  we  selected  motors  with  large  diameters.  The  motor  to  drive  joint  1  is 
56  cm  in  diameter  with  204  Nm  peak  torque.  Joint  2  has  two  motors,  one  on  each  side  of  the  upper  arm. 
These  motors  are  30  cm  in  diameter  with  a  total  of  136  Nm  peak  torque.  It  is  required  that  the  motors  at  joints 
4.  5  and  6  have  not  only  high  torque  but  also  lightweight  and  compact  size,  because  heavy  motors  at  these 
joints  give  a  large  load  for  the  upper  joints.  Therefore  we  used  high  performance  torque  motors  with 
samarium  cobalt  magnets,  whose  maximum  magnetic  energy  is  3  to  10  times  larger  than  that  of  conventional 
ferrite  or  alnico  magnets.  The  two  samarium  cobalt  motors  to  drive  joint  4  arc  23  cm  in  diameter  with  54  Nm 
peak  torque,  and  the  motors  for  the  last  two  joints  are  8  cm  in  diameter  with  6.8  Nm  peak  torque. 

An  optical  shaft  encoder  is  installed  at  each  joint  to  measure  the  joint  angle  and  its  angular  velocity.  We 
used  precision  encoders  combined  with  precision  gears  with  1  to  4  and  1  to  8  gear  ratios.  The  resultant 
resolution  is  16  bit  per  revolution  for  the  first  4  joints  and  15  bit  per  revolution  for  the  last  2  joints. 

3.  Mathematical  Modeling  and  Identification 

3.1 .  Kinematics 

We  describe  the  kinematic  stnicture  of  the  arm  according  to  the  Denavit  and  Hartcnbcrg  convention  [4], 
The  arm  consists  of  7  links  numbered  0  to  6  from  the  base  to  the  tip  of  the  arm.  Joint  /  is  the  joint  that 
connects  link  /- 1  to  link  L 

To  represent  the  geometry,  we  use  coordinate  frames  attached  to  each  link.  Figure  2  shows  the 
disconnected  links  of  the  direct-drive  ami  where  the  rotors  and  suitors  of  motors  arc  disassembled  and 
attached  to  separate  links.  Table  1  shows  die  geometry'  of  each  link,  where 
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s.  =  the  distance  between  x^_j  and  x^.  measured  along 

a^  =  the  distance  between  and  z^.  measured  along  x^  and 

a^.  =  the  angle  between  the  z^._^  and  z^.axes  measured  in  a  riglithand  sense  about  x^. 

Joint  displacement  is  given  by  joint  angle  0.  that  is  the  angle  between  the  x and  x .  axes  measured  in 
the  righthand  sense  about  z._  The  above  three  parameters  and  one  variable  completely  describe  the  relation 
between  any  adjacent  links. 


3.2.  Arm  Dynamics 

We  derive  the  equation  of  motion  of  the  arm  assuming  that  the  arm  consists  of  rigid  bodies.  Motion  of 
a  rigid  body  is  decomposed  into  translation  with  respect  to  its  center  of  mass  and  a  rotation  about  it.  Let  us 
denote  the  translational  velocity  of  a  link  by  a  vector  v  and  the  angular  velocity  of  rotation  by  w  respectively. 
Then  the  kinetic  energy  that  the  link  has  is  given  by 


(1) 


where  m  is  the  mass  of  the  link.  is  the  inertia  tensor  and  ^  represents  the  transpose  of  a  vector.  The 
potential  energy  of  the  rigid  body  is  given  by 

(2) 


where  =  (0, 0,  g)  is  acceleration  vector  of  gravity  and  is  the  position  vector  of  the  center  of  mass. 


The  characteristics  of  a  single  link  is  completely  represented  by  mass  m.  center  of  mass  p,  and  inertia 
tensor  about  the  center  of  mass  We  computed  these  parameters  for  each  link  of  the  direct-drive  arm 
from  the  detail  drawings.  Table  2  lists  the  center  of  mass  p  and  the  inertia  tensor  in  respect  to  each 
link-coordinate  frame. 


Each  body  in  a  scries  of  mechanical  links  has  a  constraint  in  motion  due  to  the  linkage.  Motion  of  link  4 
For  example,  is  related  to  the  movement  of  preceding  joints  from  1  to  4  Therefore  the  position,  velocity  and 
angular  velocity  involved  in  the  kinematic  energy  and  potential  energy  can  be  represented  by  joint  angles  and 
their  derivatives.  Combining  the  energies  that  all  the  links  have  and  differentiating  with  respect  to  joint 
angles,  the  following  equation  of  motion  is  obtained  [11], 
n  n  n 

E V/+  D  E  vA+Si+fOi 

j=i  j=i  k=i 

T I  is  the  torque  developed  by  the  motor  at  joint  4  The  first  term  on  the  right  hand  side  stands  for  inertia  force. 
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the  second  term,  consisting  of  products  of  angular  velocities,  stands  for  Coriolis  and  centrifugal  forces,  and 

the  third  term  stands  for  gravity  load.  and  and  fg^.  depend  on  the  arm  configuration,  namely  6^ . . 

6^.  fd.  is  the  other  disturbing  torque  such  as  friction  and  external  force,  llic  direct-drive  joints  have  friction 
only  at  the  bearings  that  support  the  Joint  axes  and  the  brushes  between  tlie  rotors  and  stators.  This  friction  is 
negligibly  small  for  most  of  the  direct-drive  joints. 


3.3.  Drive  Systems 

A  drive  sysytem  of  a  joint  consists  of  a  motor  and  a  servo  amplifier.  Since  the  motor  of  a  direct-drive 
joint  is  directly  coupled  to  its  joint  axis,  the  driving  torque  about  the  axis  is  exactly  the  same  as  the  torque 
developed  by  the  motor,  which  is  proportional  to  current  1^.  applied  to  the  motor  armature, 


T. 

t 


Kt;,. 


where  Kt^.  is  a  torque  constant.  The  electrical  characteristics  of  the  armature  arc  given  by 


(4) 


(5) 


where  is  the  applied  voluge  to  tlie  armature  of  motor  /.  R^.  is  resistance  of  the  armature.  L ,  is  its  inductance, 
and  E,.  is  the  back  EMF.  Inductance  L.  is  negligibly  small  in  most  cases.  The  back  EMF  is  proportional  to  the 
angular  velocity  of  joint  axis  and  is  given  by 


E,  =  Kt^, 


(6) 


where  the  back  EMF  constant  is  the  same  as  the  torque  constant  Kt,  in  SI  units.  The  servo  amplifier  controls 
the  applied  voltage  to  be  proportional  with  its  input  voltage 


V.  =  Ka,u, 


(7) 


where  Ka^.  is  the  gain  of  the  servo  amplifier.  The  substitution  of  eqs.(4).(6)  and  (7)  into  cq.(5)  yields 
Ka.Kt,  Kt^.;, 

where  the  inductance  L.  is  neglected.  Thus  the  drive  system  is  characteri/cd  by  the  following  paramcteis, 
Ka.Kt, 


(8) 


'  R 


(9) 


where  Ka*^  is  torque  gain  between  tlie  input  u^  and  the  exerted  torque,  and  represents  a  damping 
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coelTiciem  inherent  to  the  drive  system.  For  the  arm  we  have  developed  joints  2  and  4.  each  have  two  motors 
that  work  together.  We  used  separate  servo  amplifiers  with  a  common  input  u^,  Tlie  resultant  torque  is 
obtained  by  summing  die  torques  exerted  at  each  motor  driven  by  the  separate  amplifiers.  The  damping 
torque  is  also  the  sum  of  the  damping  torque  developed  at  each  motor.  Therefore  the  sum  of  the  torque  gains 
and  the  sum  of  the  damping  coefficients  give  the  resultant  gain  and  coefficients.  Table  3  shows  the  parameters 
identified  through  experiments. 


3.4.  Single<Link  Model  and  Frequency  Response 

As  the  first  step  in  investigating  the  characteristics  of  servomechanisms,  we  assume  a  simplified  load  for 
each  actuator.  Namely,  we  first  neglect  all  the  nonlinear  effects  such  as  Coriolis  and  centrifugal  forces  as  well 
as  gravity  torque  and  friction.  We  also  assume  that  when  joint  /  is  investigated  all  the  other  joints  are 
mechanically  immobilized.  Then  the  equation  of  motion  of  the  arm  is  t.  =  0^,  because  ^^.and  0^  for  j  #  i, 

arc  all  zero.  Figure  3  shows  the  block  diagram  of  the  single-link  drive  system.  The  blocks  enclosed  by  a 
broken  line  represent  the  control  object  including  a  servo  amplifier,  a  motor  and  the  simplified  load.  The 
velocity  feedback  E  inside  of  the  control  object  corresponds  to  the  back  EMF  of  the  motor.  ITie  equation  of 
the  control  object  is  given  by 


Ka^t;  '  Ka^Ct, 


Ka/' 


(10) 


We  identified  the  single-link  drive  systems  through  experiments.  Figures  4.  5  and  6  show  the  frequency 
response  for  joints  1.  4  and  6.  which  are  joints  at  the  shoulder,  elbow  and  wrist  of  the  arm  respectively.  The 
inertia  load  of  each  joint  varies  with  the  arm  configuration  and  payload.  Especially,  the  characteristics  of  joint 
1  vary  largely  depending  on  the  angle  of  joint  2.  The  curves  in  Figure  4  are  Bode  diagrams  for  different  arm 
configurations,  0^=Q°,  45®  and  90®,  In  none  of  the  case  the  phase  curve  exceeds  180®.  Therefore  the  control 
object  can  be  identified  as  a  second-order  system.  It  implies  that  the  effect  of  armature  inductance  appearing 
in  eq.(10)  is  negligible.  Thus  the  transfer  function  of  the  single-link  drive  system  is  given  by 


Go(s)  = - i — 

'  s(T,s-»-l) 


where  time  constant  T^.  anri  'jain  K^.  are  given  by 


(11) 


Ka, 


Ka* 


L. 


(12) 


*/ 

The  solid  curves  in  the  figures  arc  obtained  by  an  optimal  curve  fitting  to  minimize  the  mean-square 
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error  from  the  experimental  data.  The  time  constant  of  each  joint  is  then  identified  and  listed  in  the  second 
column  of  Table  4. 


4.  Issues  in  Controlling  the  Direct-Drive  Arm 

Before  we  design  a  controller  for  the  direct-drive  arm,  the  characteristics  of  the  direct-drive  arm  are 
discussed  based  on  the  previous  analysis  and  experiments.  We  compare  the  direct-drive  arm  with  a 
conventional  indirect-drive  arm  that  is  driven  through  gears  and  other  means  of  reducers. 

In  case  of  an  indirect-drive  arm.  the  torque  developed  by  a  motor  varies  while  it  is  transmitted  through 
the  reducer  between  the  motor  and  its  load.  If  its  gear  ratio  is  r.  the  exerted  torque  is  amplified  r  times,  and 
some  of  the  resultant  torque  is  spent  coping  with  friction  and  inertia  at  the  transmission  mechanism.  The 
characteristics  of  transmission  mechanisms  arc  rather  complicated,  but  let  us  assume  that  its  stiffness  is 
virtually  infinite  and  that  the  mechanisms  have  no  backlash.  The  net  torque  to  drive  the  Joint  axis,  in  the 
simplest  case,  is  given  by 

T  =rKtl-f^-r^Jje  (13) 

where  fj.  is  ftiction  and  J.j.  is  the  inertia  of  transmission  mechanism  converted  at  the  rotor  of  motor.  The  back 
EMF  is  also  r  times  larger  than  that  of  a  direct-drive  joint,  because  the  angular  velocity  of  the  motor  shaft  is  r 
times  faster  than  that  of  the  joint  axis. 

E=rKl«  (14) 


Substituting  cqs.  (13)  and  (14)  to  eq.  (5). 


Ka  Kt 
R 


u  =  T  -f  Ej.  -I-  J.J.  ^ 


where  the  inductance  of  armature  is  ignored. 


(15) 


Comparing  cq.  (8)  with  cq.  (15).  wc  can  notice  that  the  transmission  of  torque  from  the  motor  to  the 
load  is  ideally  simple  without  any  disturbance  in  the  case  of  direct  drive.  However,  wc  face  the  following 
issues  in  controlling  the  direct-drive  arm. 

•  I.OW  damping 

ITic  dumping  torque  appeared  in  the  last  term  of  cq.  (15)  is  proportional  with  the  square  of  gear 
ratio  r  as  well  as  the  squared  torque  constant  Although  the  motors  used  for  direct-drive  arm  have 
larger  motor  constants,  the  direct-drive  joint,  where  the  gear  ratio  is  1,  tends  to  show  poor 
damping  characteristics. 

The  direct  coupling  of  motors  to  their  loads  eliminates  friction  along  with  transmission 
mechanisms.  However,  since  in  a  indirect  coupling  Coulomb  friction  usually  opposes  the  joint 
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movements  and  plays  a  role  of  the  brakes  on  the  joints,  the  direct  coupling  also  leads  to  the  lower 
damping  than  that  of  indirect-drive  joints. 

As  a  matter  of  fact,  the  poor  damping  characteristics  arc  observed  in  the  data  of  time  constants 
identified  through  experiments.  Because  the  time  constant  of  die  open-loop  control  system  stands 
for  the  ratio  of  inertia  to  damping  coefficient  C.,  the  large  time  constants  in  Table  4  imply  that 
the  damping  of  the  direct-drive  joints  is  relatively  small  to  the  inertial  loads.  Therefore  wc  need  a 
means  to  increase  the  damping  and  reduce  the  time  constant  in  order  to  stabilize  the  system. 

•  Nonlinearity  and  interaction 

The  direct-drive  arm  can  move  very  fast  because  of  small  friction  and  no  reduction  of  speed. 
When  the  ann  moves,  the  more  complicated  become  the  aim  dynamics.  Coriolis  and  centrifugal 
forces  in  the  second  term  of  cq.  (3)  are  proportional  with  products  of  angular  velocities.  Therefore 
the  high-speed  direct-drive  arm  has  significantly  large  effects  resulting  from  these  nonlinear 
forces. 

The  elimination  of  the  transmission  mechanism  in  the  direct-drive  arm  makes  the  effect  of 
interactions  among  multiple  links,  the  Coriolis  and  centrifugal  forces  more  prominent  in  the 
direct-drive  arm  dynamics  than  in  the  indirect-drive  arms.  This  can  be  understood  by  considering 
the  inertia  at  the  actuator  of  the  joint  The  total  inertia  which  bears  on  the  rotor  of  the  motor  is 
the  sum  of  the  inertia  at  the  transmission  and  the  equivalent  inertia  of  its  external  load  (i.e., 
links)  converted  to  the  motor  shaft  When  we  use  a  transmission  mechanism  with  gear  ratio  r,  the 
inertia  of  the  external  load  becomes  at  the  rotor.  Thus  the  total  inertia  is  given  by 


The  gear  ratio  rcan  be  designed  so  that  the  maximum  power  transfer  from  the  motor  to  the  load  is 
obtained.  The  maximum  power  uansfer  is  realized  when  the  equivalent  inertia  of  an  external  load 
is  equal  to  that  of  the  rotor  inertia:  that  is, 

(17) 

Notice  that  J.j.  does  not  change  as  the  arm  moves,  while  varies  significantly  with  the  arm 
configuration.  The  equality  in  the  equation  (17)  is  designed  to  hold  fur  typical  arm  configuration, 
fherefore,  in  the  case  of  indirect-drive  joint  with  the  optimal  gear  ratio,  about  50  %  of  the  total 
inenia  load  does  not  change.  Only  the  latter  half  has  the  complicated  characteristics.  Thus,  the 
arm  dynamics  tend  to  be  less  sensitive  to  the  change  of  arm  configuration.  In  contrast,  in-  the  case 
of  the  direct-drive  joint,  where  r=  1,  the  complicated  arm  dynamics  is  directly  reflected  to  the 
actuators,  llic  above  arguments  suggest  that  in  controlling  the  direct  drive  arm,  wc  need  to 
compensate  the  arm  dynamics  including  all  the  terms  appeared  in  the  equation  of  motion: 
Coriolis  and  centrifugal  forces  and  interaction  of  the  multiple  links. 
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5.  Feedback  Control 

5.1.  Velocity  Feedback 

In  tliis  section,  we  discuss  velocity  feedback  to  increase  damping  of  the  direct-drh  e  joints.  In  the  case  of 
an  indirect-drive  Joint,  velocity  is  usually  measured  at  the  shaft  of  a  motor  before  the  speed  is  reduced  by 
gears.  However,  it  is  rather  difftcult  to  do  so  in  a  direct-drive  joint,  because  the  motor  speed  is  as  slow  as  the 
link  motion.  We  employed  high  resolution  shaft  encoders  to  measure  the  slow  speed  movement  of  the 
direct-drive  joint.  The  details  of  velocity  measurement  are  described  in  [8], 

Figure  3  includes  a  velocity  feedback  loop,  where  Kv  is  the  velocity  feedback  gain.  Let  us  investigate  the 
upper  limit  of  the  velocity  feedback  gain.  As  shown  in  Figure  7.  the  velocity  measurement  can  not  be  perfect 
because  of  quantization  error  and  dead  band  near  zero  speed.  The  minimum  speed  detectable  by  the 
developed  encoder  circuits  is  2  degrees  per  second  for  joints  1  to  4.  and  4  degrees  per  second  for  joints  5  and 

6.  The  quantization  error  is  1/128  of  full  scale  for  all  joints.  If  the  velocity  feedback  gain  is  extremely  large,  it 
amplifies  the  error  as  well  as  the  signal.  When  a  joint  rotates  near  the  minimum  detectable  speed,  the  velocity 
signal  alternates  frequently  between  zero  and  the  minimum  value.  ITiis  alternating  velocity  signal  gives  a  large 
fluctuation  of  control  torque  and  decreases  control  accuracy.  Figure  8  shows  the  experiments  in  slow  speed 
control.  We  observe  that  a  large  gain  Kv  causes  a  vibration  in  motion,  while  a  smooth  motion  is  obtained  for 
gain  smaller  than  a  certain  value.  The  third  column  of  Table  4  lists  the  upper  limit  of  the  velocity  feedback 
gain  for  each  joint  which  is  determined  through  experiments  for  each  joint  listed. 

Figures  4,  5  and  6  also  show  frequency  responses  of  joints  1.  4  and  6.  respectively,  after  the  velocity 
feedback  compensation  is  done  using  the  maximum  allowable  gains.  The  phase  curv  es  show  a  noticeable  lead 
of  phase,  about  50  to  60  degrees.  By  fitting  theoretical  curves  to  die  experimental  data,  we  can  obtain  the  time 
constants  for  the  improved  response,  Ihe  time  constants  of  the  improved  systems  are  listed  in  Table  4.  Ihe 
velocity  feedback  compensation  decreases  the  time  constants  6  to  13  times  smaller  than  those  without  it. 

5.2.  Gain  Adjustment 

Now  wc  proceed  to  tlie  gain  adjustment  for  the  improved  systems.  Figure  3  shows  a  position  control 
system,  where  Kp  is  the  position  feedback  gain  to  be  adjusted. 

Since  overshoot  is  usually  undesirable  in  the  control  of  mechanical  arms,  wc  adjust  the  position 
feedback  gain  Kp  so  that  the  damping  factor  is  between  0.9  and  1.  Figure  9  shows  tlic  step  response  for  joints 
1.  4  and  6;  response  (a)  is  overdamped.  response  (b)  is  underdamped.  and  response  (c)  is  critically  damped. 
Ihe  responses  for  the  three  joints  arc  recorded  in  die  same  time  scale.  3hc  response  of  joint  1.  which  has  a 
large  inertial  load,  is  relatively  slow,  while  joints  4  and  joint  6  have  very  fast  responses.  To  evaluate  the 
transient  response  wc  use  delay  time  and  settling  time  T^.  The  delay  time  is  the  time  required  for  the  step 
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response  to  reach  50  %  of  its  final  value,  and  the  settling  time  is  the  one  required  before  settling  within  5  %  of 
the  final  value.  The  delay  times  of  joint  4  and  6  arc  only  57  ms  and  82  ms  respectively.  They  show  that  the 
direct-drive  arm  we  developed  has  excellent  dynamics.  Even  joint  1  has  a  365  ms  delay  time,  which  is  fast 
enough  for  most  applications. 

5.3.  Limitation  of  Speed 

The  direct-drive  arm  has  a  very  fast  response  as  shown  in  the  previous  section.  When  a  large  step  input 
is  applied  to  one  of  the  fast  joints,  the  joint  may  be  accelerated  to  an  excessively  fast  speed  for  a  long  distance 
motion.  The  excessively  fast  motion  is  dangerous  and  is  not  desired  in  some  applications.  The  velocity 
measurement  circuit  also  has  an  upper  limit  of  measurable  speed.  If  the  joint  is  accelerated  to  a  speed  higher 
than  the  upper  limit  the  velocity  feedback  signal  saturates  and  provides  an  insufficient  damping  to  the  servo 
controller.  Tlie  resultant  insufficient  damping  causes  an  overshoot  Therefore  we  need  to  limit  for  safety,  the 
speed  within  an  appropriate  range.  To  avoid  the  acceleration  that  exceeds  the  limit  a  brake  signal  to  cancel 
the  acceleration  is  necessary.  The  ranges  in  the  curve  of  Figure  7  toward  its  ends  show  modified  velocity 
feedback  to  apply  the  brakes.  If  the  speed  exceeds  the  normal  operating  range,  the  velocity  feedback  gain  is 
increased  to  several  times  larger  than  the  normal  operation  range.  The  maximum  value  of  the  velocity 
feedback  signal  is  large  enough  to  cancel  the  acceleration  signal  no  mauer  how  fast  the  speed  is.  Therefore  the 
speed  is  limited  within  the  allowable  range. 

Figure  10  shows  the  experiments  of  transient  response  for  a  large  step  input  The  left  two  figures  are 
step  responses  for  joint  4,  the  right  two  are  for  joint  6.  The  upper  two  are  cases  without  the  limit  of  speed  and 
the  lower  two  arc  the  cases  with  the  limit  Each  figure  includes  position  and  velocity  curves  measured  by  the 
encoder.  The  measured  velocity  saturates  soon  after  the  links  begin  to  move.  We  determined  the  maximum 
allowable  speed  for  joints  1  to  4  to  be  180  deg/s,  and  for  joints  5  and  6,  360  deg/s.  When  the  speed  limit  is  not 
installed  (a),  we  notice  that  the  links  are  accelerated  too  fast  because  of  the  saturation  of  the  velocity  feedback, 
and  that  large  overshoots  appear.  On  the  other  hand,  by  the  compensation  for  velocity  measurement 
saturation  (b).  the  links  move  within  the  prescribed  speed  limits.  The  responses  also  settle  to  the  reference 
input  smoothly  without  overshooting.  The  effect  of  compensation  is  very  noticeable. 

6.  Feedforward  Control 

6.1 .  Control  Scheme 

As  we  have  discussed  in  the  previous  section,  the  multiplc-degrce-of-frccdom  motion  of  an  arm 
includes  complicated  interactions  among  links.  In  this  section,  we  discuss  the  compensation  of  interactive 
torques  among  multiple  links  and  nonlinear  torques  such  as  Coriolis,  centrifugal  and  gravity  torques. 
Feedforward  control  is  effective  in  compensating  for  the  predictable  motions,  so  long  as  the  characteristics  of 
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tiic  ann  are  identified  accurately.  Tlie  direct-drive  arm  has  die  advantage  tJiat  the  simple  structure  allows  us  to 
have  an  accurate  model  of  tlie  control  object. 

By  solving  tlie  equation  of  motion  inversely,  we  can  compute  tlie  torques  to  drive  the  arm  along  a 

specified  trajectory  [6]  [lOJ.  Let  ^^/t).  6 . .  dp.)  be  a  trajectory  of  joint  angles.  If  the  trajectory  is 

smooth  enough  to  differentiate  up  to  die  second  order  with  respect  to  umc,  the  torques  required  to  trace  the 
trajectory  with  the  specified  speed  and.accelcradon.  6^,  arc  derived  from  cq.  (3), 
n  n 

=  E  wK  +  E  w  +  <‘8> 

;=i  j.k=i 

where  J.,  b ...  and  f  are  functions  of  0  ,,  6  y,  .......  0.  and  f  .  is  Coulomb  friction  and  viscous  friction  at 

brushes  and  bearings.  If  the  identification  of  the  arm  is  perfect  and  no  other  disturbing  torque  is  applied  to  it, 
the  arm  can  move  along  die  specified  trajectory  with  the  computed  torques.  However,  as  the  arm  travels  for  a 
long  time,  unavoidable  errors  can  be  accumulated,  even  if  the  identification  error  and  the  disturbances  arc 
small.  Since  the  coefficients  involved  in  cq.  (18)  arc  valid  only  when  the  arm  configuration  is  in  the  vicinity  of 
the  predicted  state,  0^^.,  the  computed  torques  do  not  make  much  sense  if  the  actual  position  of  the  arm 
diverges  from  the  specified  trajectory.  Therefore,  we  need  to  keep  the  state  of  arm  close  to  the  reference 
trajectory.  The  feedback  controller  designed  in  the  previous  sections  provides  a  continuous  positional  error 
correction  from  their  references.  We  extend  it  to  a  controller  that  can  correct  the  error  of  joint  angle  velocities 
from  dicir  references  0^,  as  well  as  the  positional  errors.  By  combining  the  feedforward  control  widi  the 
feedback  control,  we  can  expect  that  the  former  provides  the  gross  torques  to  lead  the  arm  to  a  given 
trajectory  with  no  delay  and  that  the  latter  provides  the  fine  error  correction  to  keep  the  state  of  arm  close  to 
the  reference.  Thus  the  total  torque  applied  to  joint  /  is  given  by 

+  Kp*,{«„  -  0^4.  -  i)  (19) 

where  Kp*.  is  forward-path  gain  from  the  position  reference  to  the  torque  of  motor,  as  shown  in  Figure  11, 
Kv*  .  is  the  resultant  velocity-feedback  gain  including  the  inherent  damping  due  to  the  back  EMF  of  motor 
and  the  artificial  damping  through  velocity  feedback. 

Kp*,  =  Ka*.Kp. 

Kv* ,  =  C.  -f-  Ka* .  Kv.  (20) 

The  second  term  and  a  part  of  the  third  term  in  eq.  (19)  have  been  already  implemented  in  the  feedback 
controller  previously  designed.  What  is  to  be  added  is  to  solve  the  inverse  problem  of  arm  dynamics  by  a 
computer  and  to  provide  the  torques  and 
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6.2.  Experiments 

Figure  12  shows  the  experiment  of  feedforward  compensation  for  joint  4,  where  the  sinusoidal  inputs 
drawn  by  dash-and-dot  lines  were  given  to  the  system  as  reference  trajectories  and  its  responses  after  settling 
into  steady  oscillations.  Curve  (a)  shows  the  case  with  no  compensation,  in  wliich  significantly  large  offset  and 
phase  lag  arc  observed  as  well  as  the  reduction  of  amplitude.  Curv  e  (b)  shows  the  case  with  the  compensation 
of  gravity  torque,  where  the  offset  vanished  and  the  amplitude  was  enlarged.  In  the  case  of  (c)  where  the 
damping  torque  and  Coulomb  friction,  Kv*^^^  +  fc^,  as  well  as  the  gravity  torque  were  compensated,  a 
remarkable  improvement  in  phaselag  can  be  seen.  When  all  the  arm  dynamics  were  taken  into  account,  the 
resultant  response,  curve  (d),  shows  the  excellent  coincidence  with  the  reference  trajectory.  We  observed  the 
excellent  corrrcspondence  with  sinusoidal  inputs  over  wide  ranges  of  frequency  and  amplitude,providcd  none 
of  the  driving  torque,  angular  velocity  and  acceleration  exceeds  their  limits. 

Figure  13  shows  the  responses  of  joints  4  and  6  where  sinusoidal  reference  trajectories  were  given  to 
them  simultaneously.  When  no  feedforward  compensation  was  applied,  a  noticeable  interaction  horn  joint  6 
to  joint  4  was  observed.  After  the  full  dynamics  of  the  two  joints  were  compensated  tlirough  the  feedforward 
control,  no  significant  interaction  between  them  was  observed  and  both  trajectories  showed  excellent 
coincidence  with  the  references. 


7.  Evaluation  of  Steady >State  Characteristics 

7.1.  Positioning  Accuracy 

In  this  section  we  evaluate  the  developed  arm  with  respect  to  steady-state  errors.  Figure  14  summarizes 
the  experiment  of  positioning  accuracy,  where  the  histogram  of  steady-state  positioning  errors  for  a  step 
response  is  shown.  Each  histogram  is  obtained  by  more  than  200  trials  of  the  step  response  from  the  same 
point  to  the  same  destination.  After  settling  to  a  final  position,  the  joint  angle  was  measured  by  a  high 
resolution  encoder.  The  horizontal  line  in  each  figure  indicates  the  error  from  the  dcstinauon  (0  degree). 
Means  and  standard  deviations  were  computed  for  each  joint.  To  improve  positioning  accuracy,  we 
implemented  phase-lag  compensators  which  increase  loop  gains  10  times  larger  in  the  lower  frequencies. 
While  joint  1.  in  figure  (a),  had  a  large  offset  (2.208  deg.)  under  no  compensation,  it  is  reduced  to  -0.287  deg., 
which  is  a  reasonable  error  when  compared  to  indircci-drive  arms.  More  importantly,  the  standard  deviations 
indicated  in  the  figure  arc  very  small;  especially  when  the  phase  lag  compensation  was  used,  the  deviation  is 
only  0.019  deg.  The  smaller  joints,  joints  4  and  6.  show  an  especially  good  positioning  performance.  The  small 
standard  deviations.  0.005  deg.  for  joint  4  and  0.003  deg.  for  joint  6,  show  that  the  direct-drive  arm  has  a  great 
advantage  in  terms  of  accuracy  as  well  as  speed.  One  of  the  reasons  for  the  excellent  repeatability  is  that  it 
docs  not  contain  uncertain  factors  such  as  large  friction  at  gears  and  deflection  at  chains  of  the  direct-drive 
arm  and  other  flexible  components. 
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7.2.  Servo  Stiffness 

Although  the  direct-drive  arm  has  less  internal  disturbances,  it  is  subject  to  external  disturbances  in 
actual  operations.  For  example,  die  arm  mechanically  interacts  with  environments  during  manufacturing 
operations,  or  when  the  ann  grasps  an  unknown  payload.  Since  the  disturbances  are  not  predictable  in  most 
cases,  we  cannot  compensate  for  diem  through  the  feedforward  control  discussed  in  die  previous  section. 


We  evaluate  die  sensitivity  of  the  developed  arm  to  external  disturbances.  Assuming  that  a  disturbing 
torque  f^  is  applied  to  a  joint  axis  as  shown  in  Figure  3.  the  steady-state  error  for  diis  system  is  given  by 


(21) 


To  evaluate  we  compute  the  deflection  due  to  the  load  applied  at  the  tip  of  each  link.  Suppose  the  link 
length  is  /  and  the  disturbing  force  F^  is  applied  at  the  tip.  Tlien  f^  =  /  F^,  and  the  resultant  deflection  d  at  the 
tip  of  the  link  is 


d  = 


/e 


steady 


/^F 

Kp* 


(22) 


We  define  the  serv'o  stiffness  Ks  of  a  single  link  drive  system  by  the  rado  of  applied  force  Fj  to  the  deflection 
d[ll]. 


F. 

Ks  =  -d. 

d 


(23) 


The  servo  stiffness  for  joints  1.  4  and  6  are  listed  in  Table  5.  The  resultant  stiffness  under  the  phase-lag 
C(  npensation  is  sufficiently  large  and  comparable  to  the  Stanford  Manipulator  (llj. 


8.  Conclusion 

This  paper  has  presented  theories  and  experiments  of  controlling  the  direct-drive  arm.  After  describing 
the  outline  of  the  CMU  DDArm.  we  developed  the  mathematical  model  of  the  direct-drive  arm  dynamics. 
From  the  comparison  with  indirect-drive  methods,  the  advantages  of  the  direct-drive  arm  in  dynamics 
became  clear.  The  elimination  of  factors  which  arc  uncertain  and  hard  to  identify,  such  as  friction,  makes  it 
possible  to  develop  a  precise  mathematical  model  of  arm  dynamics  and  to  employ  it  in  arm  control.  At  the 
same  time,  the  modeling  enabled  us  to  identify  important  issues  in  controlling  tlic  direct-drive  arm:  low 
damping,  significance  of  link  interaction,  and  nonlinear  terms  in  arm  dynamics. 

The  experiments  in  control  of  the  direct-drive  arm  have  demonstrated  the  solutions  of  the  control 
issues,  usefulness  of  employing  a  precise  mathematical  model  into  control,  and  the  resultant  excellent 
performance  of  the  direct  drive  arm.  First  it  was  shown  that  a  sufficient  damping  can  be  provided  by  velocity 
feedback  using  accurate  measurement  of  vcItKity  by  means  t)f  high-precision  shaft  encoders.  The  transient 
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response  of  joints,  after  gain  adjustment,  proved  a  very  fast  motion  of  the  arm:  the  6-th  joint  has  less  than  60 
ms  of  delay  time  for  a  step  input,  and  even  the  largest  joint  (1st  joint)  has  about  350  ms  of  delay  time. 

Second,  the  experiment  was  performed  on  feedforward  compensation  of  gravity  force,  link  interaction, 
and  Coliolis  and  centrifugal  force.  A  remarkable  improvement  in  dynamical  performance  was  observed. 
Significance  of  this  experiment  is  that  we  have  demonstrated  usefulness  of  feedforward  compensation  by 
being  able  to  precisely  model  the  arm  dynamics,  which  is  one  of  the  biggest  advantages  of  the  direct-drive 
arm. 


Third,  the  steady-state  characteristics  were  also  measured-  The  positional  repeatability  with  0.02  to 
0.003  degree  in  standard  deviation  was  achieved.  The  measured  servo  stiffness  was  as  high  as  that  of  the 
Stanford  Manipulator. 
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Photo  1  Overall  view  of  direct-drive  arm 


Figure  2:  Disconnected  links 


Figure  3:  Block  diagram  of  singic-iink  drive  system 
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Figure  4:  Frequency  response  of  joint  1  with  various  arm  configurations 
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Figure  7:  Characteristics  of  vclcKity  measurement 
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Fieurc  9:  Experiment  of  step  response 


(deg. 


Figure  1 1 :  Feedback  and  feedforward  compensation 


compensation  feedforward  compensation 


Figure  13:  F,ffccl  of  feedforward  compensation;  case  of  multiple  joints  with  interacion 
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Tabic  2:  Mass  and  moment  of  inertia  of  CMU  DDArm 


1  i  nk 
nunber 


1 


2 


3 


4 


5 


mass 

center  of 

moment 

of  inertia 

(kg) 

mass  (m) 

(kgm  ) 

m 

P 

'link 

0.000 

33.724 

0.000 

0.000 

95.99 

-0.675 

0.000 

2.879 

0.609 

-0.015 

0.000 

0.609 

33.056 

0.000 

3.990 

0.000 

0.001 

82.61 

0.010 

0.000 

3.786 

-0.154 

-0,203 

0.001 

-0.154 

1.475 

0.029 

8.295 

0.178 

-0.012 

52.90 

-0.524 

0.178 

0.425 

0.195 

-0.007 

-0.012 

0.195 

8.237 

-0.001 

0.150 

0.000 

-0.001 

13.34 

0.024 

0.000 

0.062 

0.001 

0.002 

-0.001 

0.001 

0.150 

0.002 

0.110 

-0.002 

0.000 

4.84 

-0.176 

-0.002 

0.005 

0.000 

0.000 

0.000 

0.000 

0.110 

0.000 

0.016 

0.000 

0.000 

2.81 

0.008 

0.000 

0.011 

0.002 

0.032 

0.000 

0.002 

0.006 

6 


t 


Tabic  4;  Time  constants  and  improvement  of  dynamic  characteristics 

by  velocity  feedback 


joint  # 

time  constant  of 
open-loop  system 

T  (S) 

maximum  allowable 
velocity  feedback  gain 
Kv  (rad/SV) 

time  constant 
under  velocity  feedback 
T  (S) 

1 

0.585 

4.89 

0.092 

4 

0.269 

2.45 

0.019 

6 

0.181 

0.98 

0.017 

A 


Tabic  5:  Servo  stiffness 


length 

servo  stiffness 
without  compensation 

/(mm) 

Ks  (N/mm) 

510 

0.32 

315 

1.06 

servo  stiffness 
with  compensation 
Ks  (N/mm) 


3.2 


10.6 


110 


2.88 


28.8 


